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ABSTRACT 


This  report  contains  user  instructions  and  program  listings 
for  multiple  leg  Kalman  Filter  target  motion  analysis  (TMA) 
procedure  for  use  on  the  Hewlett-Packard  HP-41CV,  the  Hewlett- 
Packard  HP-75C,  the  Sharp  PC-1500  (Radio  Shack  TRS-80  PC-2)  and 
the  Radio  Shack  Model  100  portable  computers. 


I.  INTRODUCTION 


This  report  contains  a  multiple  leg  target  motion  analysis 
(TMA)  program  for  each  of  the  following  portable  computers;  the 
Hewlett-Packard  HP-41CV,  the  Hewlett-Packard  HP-75C,  the  Sharp 
PC-1500  (Radio  Shack  TRS-80  PC-2)  and  the  Radio  Shack  TRS-80  Model 
100.  These  programs  are  part  of  a  set  that  has  been  developed  for 
portable  computer  evaluation. 

These  programs  provide  a  means  of  implementing  a  TMA 
procedure  that  is  described  in  Appendix  I.  The  procedure  requires 
at  least  four  bearing  observations.  It  is  assumed  that  during  an 
encounter,  the  target  course  and  speed  remain  constant,  and  that 
signal  transit  times  are  zero. 

This  algorithm  is  a  Kalman  Filter  adaption  of  the  least 
squares  TMA  algorithm  given  by  Forrest  [Ref.  1]. 
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II.  THE  HEWLETT-PACKARD  HP-41CV 


HP-41CV  USER  INSTRUCTIONS. 


There  are  four  user  options.  These  options  -  called  NEW,  LEG, 
FIX  and  AOP  -  are  used  as  global  labels  in  the  HP-41CV  and  are 
assigned  to  the  keys  LN,  S+,  1/x  and  /x,  respectively,  for  access 
in  the  USER  mode.  Their  use  is  given  below.  (Memory:  SIZE  =  40, 

706  bytes  are  required)  . 


DISPLAY 

INSTRUCTION 

PRESS 

1. 

Select  USER  mode. 

USER 

2. 

Start  a  new  problem. 

LN  (NEW) 

3. 

BRG  ERR? 

Key  in  bearing  error. 

R/S 

4. 

OWN  CUS? 

Key  in  own  course. 

R/S 

5. 

OWN  SPD? 

Key  in  own  speed. 

R/S 

6. 

TGT  BRG? 

Key  in  target  bearing. 

R/S 

7. 

8. 

TIME? 

Key  in  time  (HH.MM). 

Repeat  Steps  5  and  6  for 
each  new  observation. 

R/S 

9. 

Input  a  new  leg. 

2+  (LEG) 

10. 

LEG  BRG? 

Key  in  new  leg  bearing. 

R/S 

11. 

12. 

LEG  DST? 

Key  in  distance  on  leg. 

Go  to  Step  4. 

R/S 

13. 

Compute  a  fix. 

1/x  (FIX) 

14. 

TGT  CUS:  (degrees) 

R/S 

15. 

TGT  SPD:  (knots) 

R/S 

16. 

TGT  BRG:  (degrees) 

R/S 

17. 

18. 

TGT  RNG:  (meters) 

Next  Option? 

R/S 

19. 

Compute  an  AOP 

/x  (AOP) 

20. 

SIG  1:  (n.  mi.) 

R/S 

21. 

SIG  2:  (n.  mi.) 

R/S 

22. 

23. 

ANG;  (degrees) 

Next  Option? 

R/S 
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HP-41CV  SAMPLE  PROBLEM 


The  sensor  on  your  ship  has  a  bearing  error  of  one  degree. 
Your  course  is  160  deg.  at  6  kts.  At  1200  hours  your  sensor 
detects  a  target  at  350.5  degrees.  At  1204  the  sensor  indicates 
the  target  to  be  at  1.8  deg.  To  determine  a  fix,  your  ship  makes  a 
course  change  during  which  the  course-made-good  is  130  deg.  and 
the  distance-made-good  is  556  meters.  Your  new  course  is  080  deg. 
at  6  kts.  The  maneuver  ends  at  1207,  at  which  time  the  target 
bearing  is  8.3  deg.  One  more  observation  places  the  target  at  18.4 
deg.  at  1211.  Estimate  the  target  course,  speed,  bearing,  range, 
and  AOP  at  1211  hours. 


DISPLAY  CONTENTS 

USER  RESPONSE 

LN  (NEW) 

COMMENTS 

Start  a  new  problem. 

BRG  ERR? 

1  [R/S] 

1  deg. 

OWN  CUS? 

160  [R/S] 

160  deg. 

OWN  SPD? 

6  [R/S] 

6  kts. 

TGT  BRG? 

350.5  [R/S] 

350.5  deg. 

TIME? 

12.00  [R/S] 

1200  hours. 

TGT  BRG? 

1.8  [R/S] 

1 . 8  deg . 

TIME? 

12.04  [R/S] 

1204  hours. 

TGT  BRG? 

L+  (LEG) 

Input  a  new  leg. 

LEG  BRG? 

130  [R/S] 

130  deg. 

LEG  DST? 

556  [R/S] 

556  meters. 

OWN  CUS? 

0  80  [R/S] 

080  deg. 

OWN  SPD? 

6  [R/S] 

6  kts. 

TGT  BRG? 

8.3  [R/S] 

8.3  deg. 

TIME? 

12.07  [R/S] 

1207  hours. 

TGT  BRG? 

18.4  [R/S] 

18.4  deg. 

TIME? 

12.11  [R/S] 

1211  hours. 

TGT  BRG? 

1/x  (FIX) 

Compute  a  fix. 

TGT  CUS;  123.7 

[R/S] 

course  =  123.7  deg. 

TGT  SPD:  12.6 

[R/S] 

speed  =  12.6  kts. 

TGT  BRG:  18.4 

[R/S] 

bearing  =  18.4  deg. 

TGT  RNG;  4,023.0 

[R/S] 

range  =  4023.0  meters 

NEXT  OPTION? 

/x  (AOP) 

Compute  an  AOP. 

SIG  1:  10.40 

[R/S] 

sigma  1  =  10.40  n.  mi 

SIG  2;  0.06 

[R/S] 

sigma  2  =  0.06  n.  mi. 

ANG;  18.39 

NEXT  OPTION? 

[R/S] 

angle  =  18.39  deg. 
Quit. 

HP-41CV 


eULBL  -Tffp- 
02*LBL  B9 
03  TONE  0 
e<  -NEXT  OPTION?- 
05  flVIEH 
06  GTO  99 
07«LBL  -BERP- 
08  -eRG  ERR"?- 
09  PROMPT 

10  P-P 

11  Xt2 

12  STO  23 

13  RTN 

14  GTO  9<i 
15«LBL  -HEN- 

16  SF  10 

17  ClRG 
le  1  E3 

19  STO  00 

20  STO  01 

21  STO  02 

22  STO  03 

23  1852 

24  STO  39 

25  XEQ  -BEPR- 
26»L8L  -CS- 

27  -OWN  COS’- 

28  PROHPT 

29  STO  26 

30  -OHH  SPD?- 

31  PROMPT 

32  STO  27 
33*LBL  -TB- 

34  -TGT  BRG'?- 

35  PROMPT 

36  STO  32 

37  1 

38  P-R 

39  SIO  25 

40  XOV 

41  STO  24 

42  FC’  10 

43  GTO  01 

44  32 

45  RCL  32 

46  XOV 


PROGRAM  LISTING 


47  P-P 

48  STO  10 

49  XOV 

50  STO  11 
51*LBL  01 

52  RCL  31 

53  STO  30 

54  -TIME’- 

55  PROMPT 

56  HR 

57  STO  31 

58  FS’C  10 

59  STO  30 

60  RCL  30 

61  - 

62  STO  14 

63  FS’C  09 

64  GTO  00 

65  RCL  26 

66  RCL  27 

67  RCL  14 

68  » 

69  P-R 

70  ST+  28 

71  XOV 

72  ST+  29 
73*L8L  00 

74  RCL  12 

75  RCL  14 

76  * 

77  ST+  10 

78  RCL  13 

79  RCL  14 

80  » 

81  ST+  11 

82  RCL  14 

83  ENTERt 

84  ENTERt 

85  ENTERt 

86  RCL  02 

87  ♦ 

88  RCL  05 

89  ENTERt 

90  ♦ 

91  + 

92  » 


HP-41CV  PROGRAM  LISTING  (cont.) 


93 

ST+ 

00 

94 

CLX 

95 

RCL 

09 

96 

« 

97 

RCL 

07 

98 

+ 

99 

PCL 

06 

100 

+ 

101 

« 

102 

ST+ 

04 

103 

CLX 

104 

PCL 

03 

105 

♦ 

106  RCL 

08 

107 

ENTERt 

108 

+ 

109 

110 

* 

111 

ST* 

01 

U2  CLX 
113  RCL  02 
IH  ♦ 

115  ST+  05 

116  CLX 

117  PCL  09 

118  ♦ 

119  ST+  06 

120  ST+  07 

121  CLX 

122  RCL  03 

123  ♦ 

124  ST+  08 

125  PCL  25 

126  PCL  04 

127  ♦ 

128  PCL  24 

129  RCL  00 

130  ♦ 

131  - 

132  STO  19 

133  STO  15 

134  PCL  25 

135  PCL  01 

136  ♦ 

137  RCL  24 

138  RCL  04 


139  ♦ 

140  - 

141  STO 

20 

142  STO 

16 

143  RCL 

25 

144  PCL 

07 

145  ♦ 

146  RCL 

24 

_ 1 

05 

148  * 

149  - 

150  STO 

21 

151  STO 

17 

152  PCL 

25 

153  PCL 

08 

154  * 

155  PCL 

24 

156  PCL 

06 

157  * 

158  - 

159  STO  22 

160  STO 

18 

161  PCL 

25 

162  RCL 

20 

163  » 

164  PCL 

24 

165  PCL 

19 

166  « 

167  - 

168  PCL 

10 

169  PCL 

28 

170  - 

171  Xt2 

172  PCL 

11 

173  PCL 

29 

174  - 

175  Xt2 

176  + 

177  RCL 

23 

178  ♦ 

179  + 

180  ST/ 

15 

181  ST/ 

16 

182  ST/ 

17 

183  ST/ 

18 

184  PCL 

29 
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HP-41CV  PROGRAM  LISTING  (cont.) 


185 

RCL 

11 

231 

RCL 

15 

188 

- 

232 

RCL 

21 

187 

RCL 

35 

233 

» 

188 

♦ 

234 

ST- 

05 

189 

RCL 

28 

235 

RCL 

15 

190 

RCL 

10 

236 

RCL 

22 

191 

- 

237 

♦ 

192 

RCL 

24 

238 

ST- 

06 

193 

» 

239 

RCL 

16 

194 

- 

240 

RCL 

21 

195 

STO 

33 

241 

♦ 

196 

RCL 

15 

242 

ST- 

07 

197 

♦ 

243 

RCL 

16 

198 

ST+ 

10 

244 

RCL 

22 

199 

RCL 

33 

245 

♦ 

200 

RCL 

16 

246 

9T- 

08 

201 

♦ 

247 

RCL 

17 

202 

ST+ 

11 

248 

RCL 

22 

203 

RCL 

33 

249 

♦ 

204 

RCL 

17 

250 

ST- 

09 

205 

* 

251 

GTO 

•T8- 

206 

ST+ 

12 

2524LeL 

•LEG- 

207 

RCL 

33 

253 

•Lft 

;  8RG’ 

208 

RCL 

18 

254 

PROMPT 

209 

* 

255 

•LEG 

;  DST’' 

210 

ST+ 

13 

256 

PROMPT 

211 

RCL 

15 

257 

RCL 

39 

212 

RCL 

19 

258 

/ 

213 

♦ 

259 

P-R 

2M 

ST- 

00 

260 

ST+ 

28 

215 

RCL 

16 

261 

XOY 

216 

RCL 

20 

262 

ST+ 

29 

217 

♦ 

263 

SF  09 

218 

ST- 

01 

264 

GTO 

•cs- 

219 

RCL 

17 

265*LBL 

•FIX' 

220 

RCL 

21 

266 

SF  21 

221 

* 

267 

FIX 

1 

222 

ST- 

02 

268 

RCL 

13 

223 

RCL 

18 

269 

RCL 

12 

224 

RCL 

22 

270 

R-P 

225 

* 

271 

STO 

34 

226 

ST- 

03 

272 

XEQ 

91 

227 

RCL 

15 

273 

■TGT 

CUS: 

228 

RCL 

20 

274 

flRCL 

X 

229 

* 

275 

flVFEV 

230 

ST- 

04 

276 

•TGT 

SPD 
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HP-41CV  PROGRAM  LISTING  (cont.) 


277  fiRCL  34 

278  flVIEt 

279  RCL  11 
288  RCL  29 
281  - 

282  RCL  10 

283  RCL  28 
204  - 

285  R-P 
28t  RCL  39 

287  * 

288  STO  34 

289  XEC  9! 

298  -TCT  ERG- 

291  fiPCL  X 

292  flVIEK 

293  -TGT  RNG 

294  OPCL  34 

295  RVIEU 

296  GTO  99 
2974LBL  -OOP- 

298  SF  21 

299  FIX  2 
308  RCL  80 
381  RCL  81 

302  + 

303  2 
384  / 

305  STO  33 

306  RCL  08 
387  RCL  01 
308  ' 

300  2 
318  / 

311  Xt2 


312  RCL  04 

313  Xt2 

314  + 

315  SOP7 

316  STO  34 

317  * 

318  SORT 

319  -SIGl:  ■ 
328  fiPGL  X 

321  RVIER 

322  RCL  33 

323  RCL  34 

324  - 

325  SORT 

326  -5102 •  ■ 

327  RPCL  X 

328  RVIEW 

329  RCL  04 

330  ST+  X 

331  RCL  08 

332  RCL  61 

333  - 

334  R-P 

335  XEO  91 

336  2 

337  / 

338  'PHG:  ' 
330  RPCL  X 
348  fiVIER 
341  GTO  99 
3424LBL  9i 

343  CLX 

344  368 

345  HOD 

346  EHD 
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III.  THE  HEWLETT-PACKARD  HP-75C. 


HP-75C  USER  INSTRUCTIONS. 


There  are  four  user  options.  These  options  -  labeled  1,  2,  3, 
and  4  -  are  used  to  continue  input,  input  a  new  leg,  compute  a 
fix,  and  to  compute  an  AOP,  respectively.  Their  use  is  shown 
below.  (Memory:  2727  bytes  for  program;  820  bytes  for  variables. 
Total  =  3547  bytes.) 


DISPLAY 

INSTRUCTION 

INPUT 

1. 

Run  Program. 

Run  "TI 

2. 

Units: 

Select  units: 

1  n.mi.. 

Nautical  miles. 

1 

2  yds.,  or 

yards,  or 

2 

3  m.  ? 

meters. 

3 

3. 

BRG  ERR? 

Key  in  bearing  error. 

[RTN] 

4. 

OWN  CUS? 

Key  in  own  course. 

[RTN] 

5. 

OWN  SPD? 

Key  in  own  speed. 

[RTN] 

6. 

TGT  BRG? 

Key  in  target  bearing. 

[RTN] 

7. 

TIME? 

Key  in  time  (HH.MM). 

[RTN] 

8. 

1  CONT, 

1  returns  to  Step  6. 

1 

2  LEG, 

2  goes  to  Step  9. 

2 

3  FIX, 

3  goes  to  Step  13. 

3 

4  AOP? 

4  goes  to  Step  18. 

4 

9. 

LEG  BRG? 

Key  in  new  leg  bearing. 

[RTN] 

10. 

LEG  DST? 

Key  in  distance  on  leg. 

[RTN] 

12. 

Go  to  Step  4. 

13. 

TGT  CVS:  (degrees) 

[RTN] 

14. 

TGT  SPD:  (knots) 

[RTN] 

15. 

TGT  BRG:  (degrees) 

[RTN] 

16. 

TGT  RNG:  (units) 

[RTN] 

17. 

Go  to  Step  8. 

18. 

SIG  1:  (units) 

[RTN] 

19, 

SIG  2:  (units) 

[RTN] 

20. 

ANG:  (degrees) 

[RTN] 

21. 

Go  to  Step  8. 
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HP-75C  SAMPLE  PROBLEM 

The  sensor  on  your  ship  has  a  bearing  error  of  one  degree. 
Your  course  is  160  deg.  at  6  kts.  At  1200  hours  your  sensor 
detects  a  target  at  350.5  degrees.  At  1204  the  sensor  indicates 
the  target  to  be  at  1.8  deg.  To  determine  a  fix,  your  ship  makes  a 
course  change  during  which  the  course-made-good  is  130  deg.  and 
the  distance-made-good  is  556  meters.  Your  new  course  is  080  deg. 
at  6  kts.  The  maneuver  ends  at  1207,  at  which  time  the  target 
bearing  is  8.3  deg.  One  more  observation  places  the  target  at  18.4 


deg.  at  1211.  Estimate 

the  target  course. 

speed,  bearing,  range 

and  AOP  at  1211  hours. 

DISPLAY  CONTENTS 

USER  RESPONSE 

COMMENTS 

Units:  1  n.mi.. 

2  yds . ,  or  3  m. ? 

3 

Select  meters. 

BRG  ERR? 

1  [RTN] 

1  deg. 

OWN  CUS? 

160  [RTN] 

160  deg. 

OWN  SPD? 

6  [RTN] 

6  kts. 

TGT  BRG? 

350.5  [RTN] 

350.5  deg. 

TIME? 

12.00  [RTN] 

1200  hours. 

1  CONT,  2  LEG, 

3  FIX,  4  AOP? 

1 

Continue  input. 

TGT  BRG? 

1.8  [RTN] 

1. 8  deg. 

TIME? 

12.04  [RTN] 

1204  hours. 

1  CONT,  2  LEG, 

3  FIX,  4  AOP? 

2 

Input  new  leg. 

LEG  BRG? 

130  [RTN] 

130  deg. 

LEG  DST? 

556  [RTN] 

556  meters. 

OWN  CUS? 

080  [RTN] 

080  deg. 

OWN  SPD? 

6  [RTN] 

6  kts. 

TGT  BRG? 

8.3  [RTN] 

8.3  deg. 

TIME? 

12.07  [RTN] 

1207  hours. 

1  CONT,  2  LEG, 

3  FIX,  4  AOP? 

1 

Continue  input. 

TGT  BRG? 

18.4  [RTN] 

18.4  deg. 

TIME? 

12.11  [RTN] 

1211  hours. 

1  CONT,  2  LEG, 

3  FIX,  4  AOP? 

3 

Compute  a  fix. 

CUS  =  123.7 

course  =  123.7  deg. 

SPD  =  12.6 

speed  =  12.6  kts. 

BRG  =  18.4 

bearing  =  18.4  deg. 

RNG  =  4023  m. 

range  =  4023  meters. 

1  CONT,  2  LEG, 

3  FIX,  4  AOP? 

4 

Compute  an  AOP. 

0  1  =  19263.71  m. 

sigma  1  =  19263.71  m. 

02=  105.22  m. 

sigma  2  =  105.22  m. 

ANG  =  18.4 

angle  =  18.4  deg. 

1  CONT,  2  LEG, 

3  FIX,  4  AOP? 

Quit. 
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HP-75C  PROGRAM  LISTING 


10  REf!  T«fl 
20  GOTO  68 

30  C$=KEY$  0  IF  Ct="  TH 
EH  30 

40  FOR  C=1  TO  LEN(C0t)  8 
IF  Ct=C0$[C,C]  THEN  RET 
URN 

50  HEXT  C  0  GOTO  30 
60  OPTION  BRSE  1  0  OPTIO 
N  RHGLE  DEGREES 
70  DIN  P(10),H(4),X(4> 

80  DEF  FNR(X,N)  =  1HT(N* 
X+.5)'N 

90  X0=0  0  Y0=0  0  F5=0 
100  F0=1  0  T9=0  0  L=0  0 
FOR  1=1  TO  4  0  FOR  J=I  T 
0  4  0  L=L+1  0  T=0  0  IF  1 
=J  THEM  T=1000 
110  P(L)=T  0  NEXT  J  0  NE 
XT  1 

120  DISP  -Units:  I  n.ni, 

2  ydsi  or  3  «.?  '  0  C0I 
=•123*  0  GOSUe  30  0  IJ=C 
130  IF  U=1  THEN  K=1  0  U$ 
='n«-  0  GOTO  160 

140  IF  U=2  THEN  |f=2e25  0 
U$='yds.-  0  GOTO  160 
150  IF  U=3  THEN  K=1B52  0 
U$='«.'  0  GOTO  160 
160  GOSUB  4000  0  GOSUB  4 
010  0  GOSUB  4020  0  GOSUB 
4030  0  GOSUB  4040 
170  GOTO  240 
180  DISP  •!  COHT,  2  LEG. 

3  FIX,  4  OOP"’’  0  C0»='l 
234-  0  GOSUB  30 

190  IF  C=2  THEN  GOSUB  40 

70  0  GOTO  220 

200  IF  C=3  THEN  GOSUB  10 

00  0  GOTO  1B0 

210  IF  C=4  THEN  GOSUB  10 

50  0  GOTO  180 

220  IF  F5=l  THEN  GOSUB  4 

010 

230  GOSUB  4020  0  GOSUB  4 
040 

240  X(1)=X(1)+X(3)*D9  0 
X(2)=X(2)+X(4)*D9 


250  P(l)=P(l)+(2*P(3Hpf 
B)*D9>*D9 

260  P(2)=P(2)+(P(4)+P(6) 

+P<9>*D9)*D9 

270  P(5)=P(5)+(2*PT7)+P( 

18)*D9)*D9 

2B0  P(3>=P(3)+P(B)*Ii9 
2%  pt4>=P(4)+P(9)*r9 
300  P<'6)=P(6)+P(9)*P9 
310  P(7)=P(7)+P(10)*D9 
320  H(1)=C*P‘'2»-S*P(1) 
330  H(2)=C*P(5>-S*P(2) 
340  H(3>=C*P(6)-S*P(3) 
350  H(4>=C»P(7)-S*P<'4> 
360  D=C*H(2)-S4H(1>+E4(( 
X(l)-X0)''2+(X(2)-Ye)*2) 
370  Z=Y04C-X0*S  0  S5=Z-' 
C*X(2)-S*X(1)) 

300  FOR  1=1  TO  4  0  X(n= 
X(l)+H<n/D*S5  0  NEXT  1 
390  L=0  0  FOP  1=1  TO  4  0 
FOR  J=1  TO  4  0  L=L+1  0 
P(L)=P(L>-H(1)4H(JV/D  0 
NEXT  J  0  NEXT  I 
400  GOTO  180 
1000  X2=X(1)-X0  0  Y2=X(2 
)-Y0  0  P2=S0P(X24X2+Y2»Y 
2)  0  B2=PNGLE(X2,Y2^  0  1 
F  62<0  THEN  B2=B24360 
1010  X2=X(3>  0  Y2=X(4)  0 
S2=S0P(X2*X2+Y2*Y2)  0  C 
2=RHGLE(X2,V2)  0  IF  C2<0 
THEN  C2=C2+360 
1020  DISP  'CUS  =-,FNP(C2 
,10);  0  DISP  ■  SPD  =-;FN 
P(S2,10)  0  GOSUB  4180 
1030  DISP  'BPG  =-;FNP(B2 
,10);  0  DISP  ■  RNG  =’,FH 
R(P2*r,10);U$  0  GOSUB  41 
00 

1040  RETURN 

1050  P=P(1)  0  B=P(5)  0  D 
=P(2)  0  R1=RHGLE(R-B,24D 
)/2  0  IF  R1<0  THEN  R1=R1 
♦  180 

1060  S3=(P4e)/2  0  C3=SQP 
((fl-B)*2/4+D*D)  0  S1=S3+ 
C3 
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HP-75C  PROGRAM  LISTING  (cont.) 


1076  9j2=S1-CI 
1080  DISP  •  1  =  ^FNP^^' 
♦S0R<Sl),iefl),UI  0  GOSliB 
4100 

1090  BISF  '  2=';W 

(K*S0P<S2),100>,UI  0  COS 
Ue  4100 

1100  DISP  -PNC  =  ■;FNP(P 
1,10)  0  GOSUE  4100  0  PET 
UPN 

4000  INPUT  'BPC  EPP’  •; 

E  0  E=R0DfE>  0  E^E»E  0  P 
ETUPN 

4010  INPUT  •nw  ells'?  •; 
C0  0  INPUT  'OUH  SPP'?  ' . 
S0  i>  PET'jPN 
4020  INPUT  TGT  BPC? 

B9  0  S=5INfB9)  0  C=C0S(B 
9)  0  PETUPN 

4018  P9=T2  0  X(1)=P‘>*C  0 
X(2)=P9*S  P  X<3)=0  0  y' 
4)=0  0  PETUPN  0  REP  P9  = 
EST  PNG 

4«40  T0=To  0  input  -tine 
O’;  T9  0  T9^FHH(T9)  0  1 
F  F0=!  then  F0=0  0  T8=T9 
4050  D9=TO-T0  t»  IF  F5=0 
THEN  X0-X0fD9*S0*COS(C0) 
0  Y0=YB+D9*S0*SIH(C0) 
4000  F5=0  0  PFTIJRH 
4070  INPUT  -LEG  BPG'’  '  ; 
BP  0  b0=FHH(B0)  0  INPUT 
•LEG  DST"?  • ;  PF  0  P8=R8' 
F 

4080  X0=X0+P8*roS(BS)  0 
Y0=Y0+PR*SIN(B8> 

4090  F5=l  0  RETURN 
4100  HOIT  5  0  PETUPN 
4110  DEF  FHH(V) 

4120  H=1NT<V)  a  V-FP(V)» 
100  0  FNH=(100*FP(VV60+ 
IHT(V)T/80+H 
4130  END  DEP 
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IV.  THE  SHARP  PC-1500  (RADIO  SHACK  TRS-80  PC-2). 


SHARP  PC-1500  (TRS-80  PC-2)  USER  INSTRUCTIONS. 


There  are  three  main  user  options.  These  options  -  labeled  1, 
2,  and  3  -  are  used  to  continue  input,  input  a  new  leg,  and  to 
compute  a  fix,  respectively.  Other  options  include  unit  selection 
(n.  mi.,  yds.  or  meters)  and  AOP  selection.  Their  use  is  shown 
below.  (Memory;  2050  bytes  for  program;  number  of  bytes  for 
variables  is  not  available.) 


DISPLAY 

INSTRUCTION 

INPUT 

1. 

Run  Program. 

RUN  [ENTER] 

2. 

Units : 

Select  units: 

1  n.mi.. 

Nautical  miles. 

1 

2  yds..  Dr 

yards,  or 

2 

3  meter? 

meters. 

3 

3. 

BRG  ERR? 

Key  in  bearing  error. 

[ENTER] 

4. 

OWN  CUS? 

Key  in  own  course. 

[ENTER] 

5. 

OWN  SPD? 

Key  in  own  speed. 

[ENTER] 

6. 

TGT  BRG? 

Key  in  target  bearing. 

[ENTER] 

7. 

TIME? 

Key  in  time  (HH.MM). 

[ENTER] 

8. 

1  CONT, 

1  returns  to  Step  6. 

1 

2  LEG, 

2  goes  to  Step  9. 

2 

3  FIX? 

3  goes  to  Step  13. 

3 

9. 

LEG  BRG? 

Key  in  new  leg  bearing. 

[ENTER] 

10. 

LEG  DST? 

Key  in  distance  on  leg. 

[ENTER] 

12. 

Go  to  Step  4. 

13. 

TGT  CUS;  (degrees) 

[ENTER] 

14. 

TGT  SPD;  (knots) 

[ENTER] 

15. 

TGT  BRG;  (degrees) 

[ENTER] 

16. 

TGT  RNG;  (units) 

[ENTER] 

17. 

AOP?  Y  or  N 

Y  goes  to  Step  18. 

Y 

N  goes  to  Step  8. 

N 

18. 

SIG  1;  (units) 

[ENTER] 

19. 

SIG  2;  (units) 

[ENTER] 

20. 

ANG;  (degrees) 

[ENTER] 

21. 

Go  to  Step  8. 
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SHARP  PC-1500  (TRS-80  PC-2)  SAMPLE  PROBLEM 


The  sensor  on  your  ship  has  a  bearing  error  of  one  degree. 
Your  course  is  160  deg.  at  6  kts.  At  120G  hours  your  sensor 
detects  a  target  at  350.5  degrees.  At  1204  the  sensor  indicates 
the  target  to  be  at  1.8  deg.  To  determine  a  fix,  your  ship  makes  a 
course  change  during  which  the  course-made-good  is  130  deg.  and 
the  distance-made-good  is  556  meters.  Your  new  course  is  080  deg. 
at  6  kts.  The  maneuver  ends  at  1207,  at  which  time  the  target 
bearing  is  8.3  deg.  One  more  observation  places  the  target  at  18.4 
deg.  at  1211.  Estimate  the  target  course,  speed,  bearing,  range, 
and  AOP  at  1211  hours. 


DISPLAY  CONTENTS 

USER  RESPONSE 

COMMENTS 

Units:  1  n.mi., 

2  yds . ,  or  3  m. 

7 

3 

Select  meters. 

BRG  ERR? 

1 

[ENTER] 

1  deg. 

OWN  CUS? 

160 

[ENTER] 

160  deg. 

OWN  SPD? 

6 

[ENTER] 

6  kts . 

TGT  BRG? 

350.5 

[ENTER] 

350.5  deg. 

TIME? 

12.00 

[ENTER] 

1200  hours. 

1  CONT,  2  LEG,  3 

FIX? 

1 

Continue  input. 

TGT  BRG? 

1.8 

[ENTER] 

1 . 8  deg. 

TIME? 

12.04 

[ENTER] 

1204  hours. 

1  CONT,  2  LEG,  3 

FIX? 

2 

Input  new  leg. 

LEG  BRG? 

130 

[ENTER] 

130  deg. 

LEG  DST  meters? 

556 

[ENTER] 

556  meters. 

OWN  CUS? 

0  80 

[ENTER] 

080  deg. 

OWN  SPD? 

6 

[ENTER] 

6  kts. 

TGT  BRG? 

8.3 

[ENTER] 

8.3  deg. 

TIME? 

12.07 

[ENTER] 

1207  hours. 

1  CONT,  2  LEG,  3 

FIX? 

1 

Continue  input. 

TGT  BRG? 

18.4 

[ENTER] 

18.4  deg. 

TIME? 

12.11 

[ENTER] 

1211  hours. 

1  CONT,  2  LEG,  3 

FIX? 

3 

Compute  a  fix. 

CUS  =  123.7 

SPD  =  12.6 

BRG  =  18.4 

RNG  =  4023  m. 

AOP?  Y  or  N 

SIGl  =  19263.71  IT 
SIG2  =  105.22  m 

ANG  =  18.39 

1  CONT,  2  LEG,  3 

t. 

i. 

FIX? 

Y 

course  =  123.7  deg 
speed  =  12.6  kts. 
bearing  =  18.4  deg 
range  =  4023  meter: 
Compute  an  AOP. 
sigma  1  =  19263.71 
sigma  2  =  105.22  m 
angle  =  18.39  deg. 
Quit. 
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SHARP  PC-1500  (TRS-80  PC-2)  PROGRAM  LISTING 


l0:REn  TnA 
15:  WAIT  .-GOTO  30 
20:C$=INKEY$  : IF 
C$='"'THEN  20 
22: FOR  C=1T0  LEN 
(C0$): IF  C$= 
n]D$  (C0$,  C,  1) 
THEN  RETURN 
24:NEXT  C:GOTO  20 
30:Din  P<  10),  H<:4) 
,X(:4):RD=P1  /I 
80: DEGREE 
50:X0=0: Y0=0:F5=0 
60:F0=1:T9=0:L=0: 
f=OR  1  =  1  TO  4: 
FOR  J=ITO  4:L= 
L+1 : T=0: IF  1=J 
THEN  LET  T=100 
0 

70:P(L)=T:NEXT  J: 
NEXT  1 

80:  PAUSE  ”1  n.Tii, 
2  yds,  or  3  m 
et  er?" 

85:C0$="123": 

GOSUB  20:K=C 
90: IF  K=1THEN  LET 
U$="  n. m 1 . " : 
GOTO  130 

100: IF  K=2THEN  LET 
K=2025:U$="  yd 
s, ":GOTO  130 
110: IF  K=3THEN  LET 
K=1852:U$="  me 
tens" 

130:GOSUB  4000: 
GOSUB  4010: 
GOSUB  4020: 
GOSUB  4030: 
GOSUB  4040 
140:GOTO  210 
150: PAUSE  "1  CONT, 
2  LEG,  3  FIX? 
":C0$="123": 
GOSUB  20:CLS  : 
WAIT 

160: IF  0=2 THEN 
GOSUB  4070: 
GOTO  190 
170: IF  C=3THEN 
GOSUB  1000: 
GOTO  150 


190: IF  F5=1THEN 
GOSUB  4010 

200: GOSUB  4020: 
COSUB  4040 

210:X(1)=X(1)+X(3) 
:|:D9:X(2)=X(2)  + 
X(4)*D9 

220:P<1)=P(1)+(2*P 

(3)+P(8)*D9)*D 

9 

230:P<2)=P<2)  +  (:P(4 
)+P<6)+P(9)*D9 
)  *09 

240:P(5)=P(5)+(2*P 
(7>+P( 10)*D9)* 
09 

250:p<3)=P(3)+P(8‘' 

*09 

260:P<4)=P(4)+P(9) 

*09 

270:P(6)=P(6)-rP(9) 

*09 

280:P<7)=P(7)+P( 10 
)  *09 

290:H< 1 )=C*P(2)-S* 
P<  1 ) 

300:H(2)=C*P(5)-S* 

P(2) 

310:H<3)=C*P(6)-Si- 

P<3) 

320:H<4)=C*P(7)-S* 

P<4) 

330:O=C*H(2)-S*H(1 

)+E*((X(l)-X0) 

^2+<X(2)-Y0)^2 

) 

340:Z=Y0*C-X0*S:S5 

=Z-(C*X(2)-S*X 

(1)) 

350: FOR  1.--:1T0  4:X( 

1 )=X( 1 )+H< 1 )/D 
*S5:NEXT  1 

360:L=0:FOR  1  =  1  TO 
4:  FOR  J--1T0  4; 
L=L+1 :P(L)=P(L 
)-H( 1 )*H(J)/D; 
NEXT  J:NEXT  I 

370: GOTO  150 

1000:X=X(l)-X0;Vi: 

XC2)-Y0;R2= 
SQR  (X*X+Y*Y 
): COSUB  5000 
: B2=AT 
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SHARP  PC-1500  (TRS-80  PC-2)  PROGRAM  LISTING  (cont.) 


1010: X=X(3): Y^X<4 
):S2=SQR  (X:*: 
X+YXY):GOSUB 
5000:C2=AT 
1020:n=10:X=C2: 
GOSUB  5010: 
PRINT  'TGT  C 
US  =";X:X=S2 
:G0SUB  5010: 
PRINT  "TGT  S 
PD  ='';x 

1030: X=B2: GOSUB  5 
010:PRINT  "T 
GT  BRG  =”;X: 
X^R2Xk; GOSUB 
5010:PRINT  ■ 
TGT  RNG  =‘’;X 

;u$ 

1040: PAUSE  "AOP? 

Y  or  N  '‘;C0$ 
•--•"YyNn": 
GOSUB  20:CLS 
1050;  IF  02THEN 
RETURN 

1080:  A-P<l.i;B-P<5 
).D^P(2):X=A 
-B. v=2XD. 
GOSUB  5000: A 
l=AT/2 

1090.S3-<A^B)/'2:C 
3-^SQR  <(A-B) 
'^2/440*0) 
1100:S1=S34C3:S2= 
S3-C3 

1110:11^100. X^KX 
SQR  c.Sl); 
GOSUB  5010: 
PRINT  'SIGI= 
;XIU$ 

1120:X=KXSQR  (S2) 

: GOSUB  5010: 
PRINT  ''SIG2 

='';x;u$ 

1 1 30 :X^Al: GOSUB  5 
010:PRINT  "A 
NG  ='';X: 
RETURN 


4000: INPUT  "BRG  L 
RR?  ":E;E^E^ 
RD:E=EXE; 
RETURN 

4010: INPUT  "OUN  C 
US?  "•;C0: 
INPUT  "OWN  S 
PDP  ' ; S0; 
RETURN 

4020: INPUT  ' tqT  p 
R6?  '  ;  B9;  S=- 
SIN  B9;C-C0S 
B9:RETURN 
4030:R9^32;X(1 )^R 
9^C;  X(2)^R9>: 
S: X(3)=0. X(4 
)=0: RETURN 
4040: T8=T9. INPUT 
"TIME?  '';T9. 
CLS  :T9^dEG 
T9: IF  P0^1 
THEN  LET 
0:  T8::.T9 

4050: D9=T9-T8; 1^ 
F5=0THEN  LET 
X0-X04D9XS01: 
COS  C0;V0-V0 
+D9XS0XSIN  C 
0 

4060: P5=0. RETURN 
4070: INPUT  "LEG  B 
RG?  '■:B8;BR-- 
DEG  B8 

4075:UAIT  0:PRINT 
"LEG  DST  '  ;U 
INPUT 

■'.;R8.  PAUSE  . 
R8=R8^K 

4080: X0=X0+R8XCOS 
B8:  V0=Y0  +  RRi: 
SIN  B8 

4090:  P5=^l;  RETURN 
5000:AT^ATN  (WCX 
+  1E-9:1;(0=X) ) 
)4180X(X<0): 
AT=AT4360X(A 
T<0):RETURN 
5010:X^INT  <n*X+. 
5)/n: RETURN 
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V.  THE  RADIO  SHACK  TRS-80  MODEL  100 


RADIO  SHACK  TRS-80  MODEL  100  USER  INSTRUCTIONS. 


There  are  four  user  options.  These  options  -  labeled  1,  2,  3, 
and  4  -  are  used  to  continue  input,  input  a  new  leg,  compute  a 
fix,  and  to  compute  an  AOP,  respectively.  Their  use  is  shown 
below.  (Memory:  2503  bytes  for  program;  815  bytes  for  variables. 
Total  =  3318  bytes.) 


DISPLAY 

INSTRUCTION 

INPUT 

1. 

Run  Program. 

Run  [ENTER] 

2. 

Units : 

Select  units: 

1  n.mi.. 

Nautical  miles. 

1 

2  yds.,  or 

yards,  or 

2 

3  m.? 

meters? 

3 

3. 

BRG  ERR? 

Key  in  bearing  error. 

[ENTER] 

4. 

OWN  CUS? 

Key  in  own  course. 

[ENTER] 

5. 

OWN  SPD? 

Key  in  own  speed. 

[ENTER] 

6. 

TGT  BRG? 

Key  in  target  bearing. 

[ENTER] 

7. 

TIME? 

Key  in  time  (HH.MM) . 

[ENTER] 

8. 

1  Continue, 

1  returns  to  Step  6. 

1 

2  Leg, 

2  goes  to  Step  9. 

2 

3  Fix,  or 

3  goes  to  Step  13. 

3 

4  AOP? 

4  goes  to  Step  18. 

4 

9. 

LEG  BRG? 

Key  in  new  leg  bearing. 

[ENTER] 

10. 

LEG  DST? 

Key  in  distance  on  leg. 

[ENTER] 

12. 

Go  to  Step  4. 

13. 

TGT  CUS:  (degrees) 

[ENTER] 

14. 

TGT  SPD:  (knots) 

[ENTER] 

15. 

TGT  BRG:  (degrees) 

[ENTER] 

16. 

TGT  RNG:  (units) 

[ENTER] 

17. 

Press  any  key  to  continue. 
Go  to  Step  8. 

[ENTER] 

18. 

SIG  1:  (units) 

[El  TER] 

19. 

SIG  2:  (units) 

[ENTER] 

20. 

ANG:  (degrees) 

[ENTER] 

21. 

Press  any  key  to  continue. 
Go  to  Step  8. 

[ENTER] 
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RADIO  SHACK  TRS-80  MODEL  100  SAMPLE  PROBLEM 


The  sensor  on  your  ship  has  a  bearing  error  of  one  degree. 
Your  course  is  160  deg.  at  6  kts.  At  1200  hours  your  sensor 
detects  a  target  at  350.5  degrees.  At  1204  the  sensor  indicates 
the  target  to  be  at  1.8  deg.  To  determine  a  fix,  your  ship  makes  a 
course  change  during  which  the  course-made-good  is  130  deg.  and 
the  distance-made-good  is  556  meters.  Your  new  course  is  080  deg. 
at  6  kts.  The  maneuver  ends  at  1207,  at  which  time  the  target 
bearing  is  8.3  deg.  One  more  observation  places  the  target  at  18.4 
deg.  at  1211.  Estimate  the  target  course,  speed,  bearing,  range, 
and  AOP  at  1211  hours. 


DISPLAY  CONTENTS  USER  RESPONSE  COMMENTS 


Units :  1  n.mi . , 

2  yds.,  or  3  m.? 

BRG  ERR? 

1 

OWN  CUS? 

160 

OWN  SPD? 

6 

TGT  BRG? 

350.5 

TIME? 

12.00 

1  Continue,  2  Leg, 

3  Fix,  or  4  AOP? 

TGT  BRG? 

1.8 

TIME? 

12.04 

1  Continue,  2  Leg, 

3  Fix,  or  4  AOP? 

LEG  BRG? 

130 

LEG  DST  meters? 

556 

OWN  CUS? 

0  80 

OWN  SPD? 

6 

TGT  BRG? 

8.3 

TIME? 

12.07 

1  Continue,  2  Leg, 

3  Fix,  or  4  AOP? 

TGT  BRG? 

18.4 

TIME? 

12.11 

1  Continue,  2  Leg, 

3  Fix,  or  4  AOP? 

CUS  =  123.7 
SPD  =  12.6 

BRG  =  18.4 

RNG  =  4023  m. 

1  Continue,  2  LEG, 

3  Fix,  or  4  AOP? 
SIG  1  =  19263.71  m. 
SIG  2  =  105.22  m. 

ANG  =  18.39 

1  Continue,  2  LEG, 

3  Fix,  or  4  AOP? 


3  Select  meters. 


[ENTER] 

1 

deg. 

[ENTER] 

160 

deg. 

[ENTER] 

6 

kts . 

[ENTER] 

350.5 

deg. 

[ENTER] 

1200 

hours . 

1 

Continue 

!  input 

[ENTER] 

1.8 

deg. 

[ENTER] 

1204 

hours. 

2 

Input  new  leg. 

[ENTER] 

130 

deg . 

[ENTER] 

556 

meters 

[ENTER] 

0  80 

deg . 

[ENTER] 

6 

kts . 

[ENTER] 

8.3 

deg. 

[ENTER] 

1207 

hours. 

1 

Continue  input 

[ENTER] 

18.4 

deg. 

[ENTER] 

1211 

hours . 

3 

Compute 

a  fix. 

course  =  123.7  deg. 
speed  =  12.6  kts. 
bearing  =  18.4  deg. 
range  =  4023  meters. 

4  Compute  an  AOP. 

sigma  1  =  19263.71  m 
sigma  2  =  105.22  m. 
angle  =  18.39  deg. 

Quit. 
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TRS-80  MODEL  100  PROGRAM  LISTING 


10  REM  TMA 

20  DIMP(4,4)  ,H(4) ,X{4) :PI=4*ATN{1) :TP=PI+PI ;RD=PI/180 :GOTO50 

25  F0RC=lT09:C$=INKEy$:NEXTC 

26  PRlNT:PRINT"Press  any  key  to  continue." 

27  C$=INKEY$:IFC$=""G0T027 

28  RETURN 

32  F0RC=lT09:C$=INKEy$:NEXTC 

33  C$=INKEy$:IFC$=""G0T033 

34  C=ASC(C$)  :C$=CHR${C+32*  (090)  ) 

35  FORC=1TOLEN{C0$) : IFC$=MID$ {C0 $, C, 1 ) THENRETURN 

36  NEXTC:G0T033 

40  X=INT(M*X+.5)/M:RETURN:REM  ROUND 
50  X0=0 :y0=0 :F5=0 

60  F0=1 :T9=0 :F0RI=1T04 :F0RJ=lT04 :T=0 : IFI=JTHENT=1000 
70  P{I, J)=T:NEXTJ:NEXTI 

80  CLS:PRINT"Units:  ".-PRINT"  1  -  n.mi.," 

82  PRINT"  2  -  yds,  or":PRINT"  3  -  meters?" 

85  C0$="123" :GOSUB32:K=C 
90  IFK=1THENU$="  n.mi . " :GOTO130 
100  IFK=2THENK=2025 :U$="  yds. " ;GOTO130 
110  IFK=3THENK=1852 :U$="  meters." 

130  GOSUB4000 :GOSUB4010 :GOSUB4020 :GOSUB4030 :GOSUB4040 
140  GOTO210 

150  CLS:PRINT"Select  Option :" iPRINT"  1  -  Continue," 

152  PRINT"  2  -  New  Leg,":PRINT"  3  -  Fix,  or"  .-PRINT"  4  -  AOP?" 

153  C0$="1234" ;GOSUB32;CLS 
160  IFC=2THENGOSUB4070 ;GOTO190 
170  IFC=3THENGOSUB1000  .-GOTO150 
180  IFC=4THENGOSUB1080 :GOTO150 
190  IFF5=1THENGOSUB4010 

200  GOSUB4020 ;GOSUB4040 

210  X(1)=X(1)  ♦■X(3)  *D9:X(2)=X(2)+X(4)  *D9 

220  P{1,1)=P(1,1)+(2*P{1,3)+P(3,3) *D9) *D9 

230  P{1,2)=P{1,2)+(P(1,4)+P(2,3)+P{3,4) *D9) *D9 

240  P{2,2)=P(2,2)+(2*P(2,4)+P(4,4) *D9) *D9 

250  P(1,3)=P(1,3)+P(3,3) *D9 

260  P{1,4)=P(1,4)+P(3,4) *D9 

270  P(2,3)=P(2,3)+P(3,4) *D9 

280  P(2,4)=P(2,4)+P(4,4)*D9 

290  F0RI=1T04 :F0RJ=IT04 ;P{J,I)=P(I,J) ;NEXTJ:NEXTI 
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TRS-80  MODEL  100  PROGRAM  LISTING  (cont.) 


300  H(1)=C*P(1,2)-S*P(1,1) 

310  H(2)=C*P(2,2)-S*P(2,1) 

320  H(3)=C*P(3,2)-S*P{3,1) 

330  H(4)=C*P(4,2)-S*P{4,1) 

340  D=C*H (2)-S*H (1) +E* { (X { 1 ) -X0) "2+(X (2 ) -y0 ) "2) 

350  Z=Y0*C-X0*S:S5=Z-{C*X{2)-S*X{1) ) 

360  F0RI=1T04;X{I)=X{I)+H(I)/D*S5;NEXTI 

370  F0RI=1T04 :F0RJ=1T04 :P{I, J)=P{I, J)-H(I) *H ( J ) /D : NEXTJ : NEXTI 
380  GOTO150 

1000  X=X{1)-X0:Y=X(2)-Y0:R2=SQR(X*X+Y*Y) :GOSUB5000 : B2=AT 
1010  X=X(3) :Y=X{4) : S2=SQR {X*X+Y*Y) :GOSUB5000 : C2=AT 
1020  M=10 :X=C2/RD:GOSUB40 :PRINT"TGT  CUS 
=";X:X=S2:GOSUB40:PRINT"TGT  SPD  =";X 

1030  X=B2/RD:GOSUB40 :PRINT"TGT  BRG  = " ;X :X=R2 *K :GOSUB40 : PRINT"TGT 
RNG  =";X;U$ 

1040  GOSUB25 rRETURN 

1080  A=P{1,1) :B=P{2,2) :D=P(1,2) :X=A-B : Y=D+D :GOSUB5000 : Al=AT/2 
1090  S3={A+B)/2:C3=SQR{ (A-B) "2/4+D*D) :S1=S3+C3 
1100  S2=S3-C3 

1110  M=100:X=K*SQR(S1) :GOSUB40:PRINT"SIG  1  ^";X;U$ 

1120  X=K*SQR(S2) :GOSUB40:PRINT"SIG  2  =";X;U$ 

1130  X=A1/RD;GOSUB40 ;PRINT"ANG  =" ;X :GOSUB25 : RETURN 

4000  CLS;INPUT"BRG  ERR" ; E : E=E*RD : E=E*E : RETURN 

4010  INPUT"OWN  CUS";C0:C0=C0*RD:INPUT"OWN  SPD" ;S0 :RETURN 

4020  INPUT"TGT  BRG" ; B9 : B9=B9*RD : S=SIN (B9) : C=COS (B9) : RETURN 

4030  R9=32 :X{1)=R9*C:X{2)=R9*S:X{3)=0:X(4)=0:RETURN 

4040 

T8=T9;INPUT"TIME";T9:CLS:X=T9:GOSUB4110:T9=V:IFF0=lTHENF0=0:T8=T9 

4050  D9=T9-T8;IFF5=0THENX0=X0+D9*S0*COS (C0) :Y0=Y0+D9*S0*SIN(C0) 
4060  F5=0 rRETURN 

4070  INPUT"LEG  BRG" ; B8 ; B8=B 8*RD : PRINT"LEG  DST" ;U$; : INPUTR8:R8=R8/ 
K 

4080  X0=X0+R8*COS {B8) : Y0=Y0+R8*SIN{B8) 

4090  F5=l rRETURN 

4110  SS=SGN{X) rX=ABS{X) rH=INT(X) rM0=l rGOSUB4200 r V=X* 

100  rX=VrGOSUB4200  r 

4120  V=SS*{ {100*X/60+INT{V) )/60+H) rRETURN 
4200  X=X-M0*INT{X/M0) rRETURNrREM  MOD  FCTN 

5000  AT=ATN(Y/(X-1E-9*{X=0)) )-PI*{X<0) r AT=AT-TP* ( AT<0 ) rRETURN 
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Appendix  I:  The  Fixing  Algorithm 


The  Kalman  Filter  TMA  model  may  be  developed  as  fellows:  A 
target  and  an  observer  move  on  a  plane  surface.  The  observer,  at 
position  (U|^,  Wj^)  ,  measures  the  target  bearing  Bj^  at  time  tj^,  for 
k  =  1,  n.  The  rectangular  coordinate  system  used  to  estimate 

the  target's  position  is  shown  in  Figure  1. 


North  (x-axis) 


Figure  1.  The  encounter  geometry.  The  north-south  coordinates  x 
and  u  and  the  east-west  coordinates  y  and  w  are 
measured  from  the  same  origin. 


In  Figure  1,  the  point  labeled  (Uj^,  Wj^)  represents  the 

tracker's  position  and  the  point  labeled  (Xj^,  Yj^)  represents  the 

true  target  position  at  tj^,  the  time  associated  with  an  observed 

bearing  Bj^.  At  time  tj^,  represents  the  true  target  bearing  and 

rj^  represents  the  true  target  range.  The  bearing  error  associated 

2 

with  an  observation  is  assumed  to  be  distributed  N(0,  Oj^)  •  The 

2  2 

;or  at  a  range  rj^,  is  then  N(0,  • 

From  Figure  1, 

'k  =  "^k  <®Tk  ■ 

which  rearranges  to 

=  U|^  sin  Bj^  -  Wj^  cos  Bj^  -  sin  Bj^  +  Yj^  cos  Bj^.  (1) 

In  the  least  squares  procedure  [Ref.  1],  one  sets 

’‘k  “  *0  ''x*'^k  ■  *^0’ ' 

^2  *  ''y^^k  -  ‘0>' 

2 

and  then  minimizes  Zej^  with  respect  to  x^,  v^  and  v^,  where 

(x0,  Y0)  represents  the  target's  position  and  v^)  represents 

the  target's  velocitY  at  time  tg.  The  minimizing  values  are  the 
estimated  position  and  velocitYf  denoted  bY  (Xgf  Yg)  and  (v^, 

Vy) f  respectivelY. 

An  identical  least  squares  model  is  obtained  if  one  sets 

z^  =  Xj^  sin  Bj^  -  Y|^  cos  Bj^  +  ej^,  (3) 

where  Zj^  is  computed  from 
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=  “k  ®k 


(4) 


-  Wj^  cos  Bj^. 

Instead  of  substituting  Equ. (2)  into  Equ.(3)  and  using  the  least 
squares  procedure,  we  treat  Equ. (3)  as  the  measurement  model  in  a 
Kalman  Filter  [Ref.  2].  The  system  model  is  taken  to  be 

Xjj  =  2,  .... 

where 

1  0  Tj^  0 

0  10  T 

0  0  1  0 

0  0  0  1 

and 

■  '■‘k  ^k  %  ''y> '  • 

In  these  equations,  Tj^  =  ~  and  [...]'  denotes  the 

transpose  matrix. 

The  measurement  model  (Equ.  3)  can  be  written  as 

"'k  =  »k^k  ®k' 

2  2 

where  ej^  =  N(0,  Rj^)  ,  Rj^  =  and 

=  [sin  “COS  Bj^  0  0]. 

If  we  let  {")  denote  an  extrapolated  quantity  (the  movement 
phase  of  the  Kalman  Filter)  and  ('‘)  denote  and  updated  estimate 
(following  an  observation),  then,  for  the  extrapolation 
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and 


A 

~  ^k“l ^k”l ^k“l * 


For  the  measurement  update. 


^k  ^  ^k^k^^k^k^k  ■*■ 


^k  ^  \  ■*■  ^k^^k  ■  ®k^k^' 


Pk  =  Pk  ■ 


Since  the  true  range  rj^  is  not  known,  we  approximate  Rj^  by 


2  2 

\  =  where 


'k  ■  ‘*k  -  *  <Jk  -  "k’"- 


To  initialize  the  filter,  we  assume  the  initial  range  of  the 
target  to  be  one  convergence  zone  (CZ),  about  32  n.  mi,,  with  a 
standard  deviation  of  one  CZ,  and  the  initial  position  is  in  the 
direction  of  the  first  bearing  observation.  Further,  the  initial 
speed  is  taken  to  be  zero  with  a  standard  deviation  of  32  knots. 
Thus,  we  set 


2^  =  [32  sin  -32  cos  0  0]  ' , 


and  the  covariance  matrix 


1000 


0  1000 


0  1000 


0  1000 
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Following  the  first  observation  we  find  ~ 

In  this  model  the  observer's  position  (Uj^,  Wj^)  at  time  tj^  is 
taken  to  be 


“k  '  “a  ''x’'k  =s' 

and, 

“k  =  "a  Vk  '^s- 


where  (u^,  Wg)  is  the  observer's  position  at  time  t^.  It  would  be 
easy  to  modify  this  algorithm  to  allow  for  multiple  sensors  by 
generating  the  sensor's  coordinates  (Uj^,  Wj^)  at  time  tj^. 

A 

If  the  elements  of  the  covariance  matrix  Pj^  are  denoted  by 
(P^j)  then  the  semimajor  and  semiminor  axes,  and  02,  of  the 
AOP  are  computed  as  follows; 


”1  '  'fll  *  ^22>/2  *  -  f22>^/''  * 

“2  '  <Pll  P22*/2  -  '<hl  -  P22>^/‘'  * 


where  the  orientation  angle  A  of  the  semimajor  axis  of  the  AOP 
is  given  by 


A  =  0.5  qatn  Pn  “  ^22^’ 

The  notation  qatan(Y,X)  denotes  arctan(y/X)  corrected  for 
quadrant. 
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Appendix  II:  Some  Computational  Details 


Let  the  elements  of  the  covariance  matrices  P  and  P  be 
denoted  by  (Pj^j)  and  (P^j)#  respectively.  Then,  suppressing 
time  dependent  subscripts,  the  covariance  extrapolation, 

A.  A 

P  =  <J>P<I>' 


can  be  expanded  into  the  following  components: 

Pll  '  Pll 

P22  *  P22  * 

P12  '  P12  *^14  ^23”^  ^34’’^ 

Pl3  *  Pl3  *  ^33^ 

Pl4  '  ^‘14  ^34’’ 

P23  '  P23  ^34'^ 

P24  =  P24  +  ^44*^ 

P33  “  P33 

^34  '  P34 

P34  '  P34 

Let  the  elements  of  PH'  be  denoted  by  (h^).  Then, 


'  P12 

cos 

B  - 

Pll 

sin 

B 

=  P22 

cos 

B  - 

P12 

sin 

B 

=  P23 

cos 

B  - 

Pl3 

sin 

B 

'  ^24 

cos 

B  - 

Pl4 

sin 

B 

the 
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and, 


HPH'  =  h2  cos  B  -  sin  B. 

Let  the  elements  of  K  be  denoted  by  (k^) .  Then, 

=  h^/D  for  i  =  1,  2,  3,  4 

where  D  =  HPH'  +  R. 

Finally, 

Pij  =  -  k^hj  for  i,  j  =  1,  2,  3,  4. 
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